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® Verfahren und Vorrichtung zur Steuerung der Bew^gungen einer Maschine 
@ Verfahren und Vorrichtung zur Steuerung der Bewe- 

gungen etner Maschine mit je einem elektrischen An- 

triebsmotor 11, 12, 13 fur jede Bewegungsachse, der je- . 

vyeils mit einem Geber 21; 22, 23 mechanisch gekoppelt 

ist, Wobet aus den Ausgarigssignalen des Gebers 21, 22, 

23 die Position der Maschine auf der Bewegungsachse 

bestimmt werden kann, und fur jede Bewegungsachse 

nur ein Startbefehl fur den Antriebsmotor, eine BeWe- 

gungsgeschwindigkeit und eine Zielposition vorgegeben 

wird, und Bewegungen beliebiger Achsen kompensiert 

werden konnen, indem in Abhangigkeit vom Erreichen ei- 

n^r bestimmten Position auf einer Achse der Startbefehl 

fur eine weitere Achse ausgelost wird. 
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Beschreibung 

Die vorliegende Erfindung betrifft ein Verfahren und eine . 
Vorrichtung zur Steuerung der Bewegungeri einer Maschine. 
mit je eiaem elektrischen Ahtriebsmptor fiir jede Bewe- 5 
gungsachse, der jeweils mit einem Geber mechanisch ge- 
koppelt ist, und wobei aus deri Ausgangssignalen des Ge- 
bers die Position der Maschine auf der Bewegungsachse be- 
stimmt werden kann. 

Das vorliegende Verfahren und die vorliegende Vorrich- i6 
tung konnen bei praktiscb alien Maschin6n Verwendung fin- 
den, bei denen bestimmte Bewegungen koordiniert erfolgen 
miissen. Insbesondere eignet sich das beschriebene Verfah- 
ren und die beschriebene Vorrichtung fiir Werkzeugmaschi- 
nen, Industriefoboter, Transport- und Be- und Entladesy- 15 
steme. Besonders vorteilhaft findet die vorliegende Erfin- 
dung Verwendung, wenn eine "V^elzahl von Bewegungsach- 
sen Oder Bewegungsvorgangeh koordiniert ablaufen soUen. 

GemaB dem bisherigen Stand der Technik konnten splche 
koordinierten Bewegungsvorgange nur mittels sehr aufwen- 20 
diger und komplexer Multiachssteuerungen realisiell wer- 
den. Dabei mufite fiir jeden Bewegurigsvoigang eine Reihe 
von Punkten festgelegt werden; die von der Maschine dann 
sukzessive angefahren wurden. Die entsprechenden Ver- 
f ahrwege dazwischen wurden ublicherweise durch Interpo- 25 
. lation, meist in Form von Polynomen hoherer Ordhung er- 
mittelt. Dies erf orderte stets eine sehr aufsvendige Zentral- 
steuerung mit hohen Rechenleistungen sowie eine sehr auf- 
wendige Steuerung der einzelnen Antriebsmotoren, 

Es ist daher Aufgabe der vorliegenden Erfindung, eine 30 
solche Steuerung erheblich zu vereinfachen, sowohl Avas die 
Zahl der Komponenten betrifft, als auch ini Hinblick auf den 
erforderlichen Programmieraufwand. . 

Erfindun^sgemaB wird diese Aufgabe durch ein gattungs- 
gemaBes Verfahren zur Steuerung der Bewegungen in einer 35 
Maschine gelost, bei dem fiir jede Bewegungsachse nur ein 
Staitbefehl fur den Antriebsmotor, eine Bewegungsge- . . 
schwindigkeit und eine Zielposition vorgegeben wird, und 
Bewegungen beliebiger Achsen kombiniert werden konnen, 
indem in Abhangigkeit vom Erreichen einer bestimmten Po- 40 
sition auf einer Achse der Startbefehl fiir eine weitere,Achse 
ausgelost wird. 

Auif diese Weise ist es nicht mehr notig, entsprechende 
Kurven durch eine definierte Anzahl von Punkten im Raum 
zu kennzeichnen. Vielmehr geniigt es erfindungsgemaB, ei- 45 
nen Startbefehl fiir eine Bewegung in einer Achse zu geben 
so\yie eine Bewegungsgeschwindigkeit und einen Endpunkt 
in diesef eindimensionalen Achse vorzugeben. Zusatzlich 
wird ein Punkt auf dieser Achse definiert, bei dessen Errei- 
chen der Beginn einer Bewegung auf der nachsten Achse 50 
gestartet werden soli. Auch auf dieser Achse ist wiederum 
•lediglich eine eindimensionale Bewegungsgeschwindigkeit 
und ein eindimensionaler Zielpunkt vorgegeben. Auf dieser 
zweiten Achse kann wiederum ein Punkt vorgegeben sein, 
an dem eine Bewegung in einer dritten Achse beginhen soil. 55 
Auf diese Weise konnen beliebig viele Achsen und Bewe- . 
gungsvorgahge miteinander kombiniert werden. . 

Besonders bevorzugt ist es dabei, die Antriebsmotoren je- 
weils niittels eines zugeh5rigen Frequenzumrichters anzu- 
steuem, der bestimmte Beschleunigungs- und Bremsrampen 60 
speichert, denen dahn der Bewegungsablauf der Antriebs- 
motoren folgt. Auf diese Weise lassen sich die Bewegungen 
der Maschine beim Hirizutreten einer Bewegung in eine an- 
dere Achsenrichtung zu beliebigen Bahnkurven verschlei- 
fen. Die Bewegungen erfolgen auf diese Weise weich und 65 
ruckfrei, was den Energiebedarf und deri VerschleiB der An- 
triebsmotoren erheblich vermindert. 

Weiter ist es dabei besonders bevorzugt, eine zehtrale' 



Steuerung vorzusehen, die iiber einen Datenbus. die Aus- 
gangssignale der Geber empfangt und iiber. den selben Da- 
tenbus dip Startbefehle sowie die voigegebenen Bewe- 
jguhgisgeschwiadigkeiten u^d' Endpositionen an die Fre- 
quenzumrichter der Motoren verteilt. Auf diese Weise ist es 
nicht mehr notig; die Motoren aufwendig iiber eine zentrale 
Steuerung zu steuem, wobei dann von der zentralen Steue- 
rung eine Leitung zu jedem der Motoren gefiihrt werden 
muB. Insbesondere bei grofien Industriemasehinen und In- 
dustrieanlagen geniigt statt dessen ein durchlauferider Da- 
tenbus. Die Verdrahtiing lind Wartung des Systems wird da- 
durch erheblich vereinfacht. 

Zusatzlich kann fiir jede Achse ein Referenzpunkt vorge- 
sehen sein, der auBerhalb der nonnalen Verfahrstrecken der 
^Maschine liegt. Auf diese Weise kann sichergestellt werden, 
daB die Maschine bei alien Betriebsbedingungen den Refe- 
renzpunkt anfahiren kann, da er ja nicht im Arbeitsbereich 
liegt, und zusatzlich kann bei Bedarf durch entsprechende 
Geber eine Neujustierung der Maschine, beispielsweise 
nach StrdihausfaU. oder Betriebsstorung problemlos voige- 
nonunen werden, 

Zur Realisierung der vorliegenden Erfindung ist eine Vor- 
richtung besonders bevorzugt, bei der fiir jede Achse ein 
Antriebsmotor vorgesehen ist, der jeweils mit einem Geber 
mechanisch gekoppelt ist, und dessen Ausgangssignale iiber 
einen Datenbus zur zentralen Steuerung gefiihrt werden, 
wobei jeder Antriebsmotor iiber einen Frequenzumrichter 
mit Energie versorgt wird, und wobei diese Frequenzum- 
richter iiber den Datenbus mit ihren Steuerbefehlen versoigt 
werden. 

Es ist dabei besonders bevorzugt, als Geber Resolver zu 
verwenden. 

Im folgenden wird die vorliegende Erfindung arihand des 
in der beigefiigten Zeichnung dargestellten Ausfiihrungsbei- 
spiels naher beschriefeen. Es zeigt: 

Fig* 1 eine schematische tJbersichtsdarstelluhg einer er- 
findungsgemafien Steuerung; 

Fig. 2 die Anordnung der einzelnen Achsen und die je- 
weiligen Referenzpunkte; und 

Fig. 3 ijien Ablauf einer kurvenformigen Bewegung, wie 
sie beispielsweise erforderlich ist, um Waren von einem 
Forderband auf eine Palette umzusetzen, wobei die Waren 
iiber ein Hinderiiis einer bestinunten Hohe hinweggehoben 
werden miissen. , ' . 

Fig. 1 zeigt den s'chematischen Aufbau der. Steuerung ei- 
ner Maschine, die Bewegungen in drei Achsen ausfuhreri 
kann. Natiirlich kann eine erfindungsgeriiaBe Steuerung 
auch fiir nur zwei oder aber beliebig viele Achsen aufgebaut 
werden. 

Fiir jede Achse X, Y, Z ist ein Drehstromsypchronmotor 
11, 12, ll3 vorgesehen. Auf der Abtriebswelle dieser Moto- 
ren 11, 12, 13 ist jeweils ein Resolver 21, 22, 23 angebracht. 
Dieser liefert Informationen iiber Drehrichtungimd Drehge- 
schwindigkeit des Motors an eiri Businterface 31, 32, 33. 
Diese Bustreiber 31, 32, 33 sind iiber eine gemeinsame Bus- 
leitung 30 miteinander und mit einer zentralen Steuerung 40 
verbunden. Die Steuerung 40 liefert andererseits iiber den 
Datenbus 30 Steuersignale an die Bustreiber 31, 32, 33, von 
denen die entsprechenden Steuerbefehle ah Frequenzum- 
richter 41, 42, 43 weitergeben werden. Jeder dieser Frequen- 
zumrichter 41, 42, 43 ist jeweils einem Mbtor U,. 12, 13 zu- 
geordnet. Vorzugsweise sind die Frequenziimrichter 41, 42, 
43 direkt an den Motoren angeorflhet. Die Ausgangsdaten 
der Resolver 21, 22, 23 werden dabei vorzugsweise iiber die 
Frequenzumrichter 41, 42, 43 zu den Businterfaces 31, 32, 
33 gefiihrt. Dadurch yerfiigt jeder Frequenzumrichter stets 
iiber die Information iiber die aktuelle Position auf seiner 
Achse. 



Die Frequenzumrichter 41, 42, 43 erhalten iiber den Da- 
tenbus 30 und die jeweiligen Bustreiber 31, 32, 33 jeweils 
Befehle von der Steuerung 40, bestimmte Strecken mit einer 
bestiiiunten Geschwindigkeit zu fahren. In den Fr^quen- 
zumrichtem 41, 42, 43 sind dazu jeweils entsprechende Be- 5 
schleunigungs- und Verzogerungsrampen gespeichert, da ja 
die Motoren nicht. beliebig schnell beschleunigt werden 
k5nnen. Entsprechend versoigendie Frequenzumrichter 41, 
42, 43 den ihnen jeweils zurgeordneten Motor 11, 12, 13 mit 
Drehstrom langsam an^teigender Frequenz. Da im vorlie- 10 
. genden Fall Synchronmotoren Verwendung finden, kann 
iiber die Frequenz die Drehzahl der Motoren genau einge- 
stellt werden. Durch die Ausgangsdaten der Resolver 21, 22, 
23 ist der jeweilige Frequenzumrichter und die Steuerung 40 
permanent iiber, die aktuelle Position informiert. Dadurch 15 
kann der Frequenzumrichter den Motor auch rechtzeitig vor 
.Erreichen des Zielpunktes mit der entsprechenden vorgege- 
benen Verzogerurigsrampe herunterregeln, so daB. die Ge- 
schwindigkeit kbntinuierlich auf Null abgesenkt wird, und 
die vorgegebene Zieippsition mit einer yemachlassigbaren 20 
Restgeschwindigkeit erreicht wird. 

Anstelle der Resolver 21, 22, 23 konnen naturlich auch 
beliebige aridere Wegegeber oder Impulsgeber Verwendung. 
finden. Entscheidend ist, daB aus den AusgangSsignalen des 
Gebers dir6kt oder iiber Integration dieser Signale die Posi- 25 
-tion der Maschine auf der jeweiligen Bewegungsachse be- 
stimmt werden kann. Es ist also erforderlich, daB die Geber 
21, 22, 23 ein der Bewegungsstrecke oder Bewegungsge- 
sch\yindigkeit proportion ales Signal und ein Signal iiber die 
Richtung der Bewegung oder ein absolutes Positionssignal 30 
erzeugen. , . 

Die Fig. 1 zeigt einen Aufbau fur eine Dreiachsensteue- 
rung. Es ist aber selbstverstandlich ebenso moglich, bei- 
spielsweise nur zwei Achsen ahzusteuem,.oder weitere Mo- 
dule hinzuzufugen, so daB nahezu beliebig viele Achsen ge- 35 
steuert werden kohnen. Durch den modularen Aufbau ist 
dazu nicht einmal eine Unistrukturierung der Anlage not- 
wendig. Es werden einfach zusatzliche Bustreiber-Frequen- • 
zumrichter-Motor-Resolvereinheiten an den Datenbus ange- 
schlossen. Die Obergrehze fur die Zahl der regelbaren Ach- 40 
sen ergibt sich dann nur noch aus der Anzahl von Geiraten, 
die maximal von dem Bus adressiert werden konnen. Selbst 
dann ist es jedoch moglich, durch Aufteilung auf mehrere 
Bussysteme noch weitere Achsen hinzuzufugen. 

Im folgenden soli das Steuerungsverfahren anhand der 45 
Fig. 2 und 3 naher erlautert werden: Zur Vereinfachung der 
zeichnerischen Darstellung wird hier nur eine Zweiachsen- 
steuerung dai;gestellt. Die zu steuemden Bewegungen der 
Maschine verlaufen also entlang einer Y-Achse 100 und ei- 
ner X-Achse 110. Am Ende der jeweiligen Achsen ist je- 50 
weils ein Referenzpunkt 102, 112 vorgesehen. Dieser Refe- 
renzpunkt ist vorzugsweise so arigeordnet^ daB er sich au- - 
Berhalb des normalen Arbeitsbereichs der Maschine befin- 
det. Durch entsprechende Anschlagsschalter kann das Refe- 
renzieren der Maschine auch automatisiert werden. Die Re- 55 
ferenzpunkte niiissen dabei nicht gleichzeitig, sondern kon- 
nen auch nacheinander angefahren werden. Erfindungsge- 
maB ist dies jedoch nur noch nach dem Einschalten der Ma- 
schine erforderlich. Selbstverstandlich kann jederzeit yon 
den Bedienurigskraften eine Referenzfahrt der Maschine 60 
ausgelost werden, wobei dies erfindungsgemaB aus jeder 
Achsenposition heraus moglich ist. 

Ein beispielhafter zweiachsiger Bewegungsablauf ist in 
der Fig, 3 dargestellt. Hierbei sind zur besseren Erlauterung 
auch noch Bahnkurvenpunkte 200 bis 214 eingezeichnet^ Es 65 
ist jedoch zu beachten, daB die erfindungsgemafie Steuerung 
diese Punkte nicht benotigt und auch nicht gezielt anfahrt. 

Das dargestellte Beispiel soil beispielsweise das Umladen 



einer Ware von einer Palette auf ein Forderband darstellen. 
bei'dem die Ware iiber ein dazwischen befindliches Hinder- 
nis hinweggiehoben werden muB. 

Bei Bahnsteuerungen geriiaB dem Stand der Technik 
miiBten ffir diese Bewegung samtliche Punkte 200 bis 214 in 
die Maschine einprogrammiert werden. ErfindungsgemaB 
erhalt die Maschine jedoch ledi^Hch folgende Befehle: 
Beim Start am Pkt 200 erhalt die Maschine den Befehl 
"Fahre mit vorgegebener Geschwindigkeit entlang der Y- 
Achse bis zu dem oberen Y- Wert". Dieser entspricht dem Y- 
Wert des Punktes 208. 

Fiir die X-Achse wird lediglich vorgegeben, wenn der Y- 
Wert dem. Y-Wert des Punktes 202 entspricht "Bewege dich 
mit vorgegebener Geschwindigkeit in X-Richtung bis zum 
Errdchen des X- Wertes des Punktes 214" ! 

Weiter erhalt die Maschine den Befehl "Beim Erreichen 
des X- Wertes des Punktes 210 eine Bewegung in Richtung 
der Y-Achse mit vorgegebener Geschwindigkeit zu starten, 
bis sie den Y-Wert des Punktes 214 erreicht hat". 

Der Fiinktionsablauf ist dann der folgende: 
Die Maschine startet amPunkt 200 und bewegt sich mit stei- 
gender Geschwindigkeit bis zum Erreichen der vorgegebe- 
nen. Geschwindigkeit in Y-Richtung in diese Richtung. 
Beim Eneichen eines vprgegebenen Y- Wertes, der den Y- 
Wert des Punktes 202 entspricht, erhalt die Maschine deh 
Befehli mit einer vorgegebenen Geschwindigkeit in X-Rich- 
tung zu fahren bis der X-Wert dem X-Wert des Punktes 214 
entspricht. Die Maschine beginnt also nun in X-Richtung zu 
beschleunigen. Gleichzeitig verringert sich jetzt die Bewe- 
gungsgeschwindigkeit in Y-Richtung, da der Frequenzum- 
richter die entsprechende Bremskurve in Y-Richtung ab- 
fahrt, und entsprechend die Motordrehzahl reduziert. Beim 
Erreichen eines entsprechenden X- Wertes, der mit Sicher- 
heit jenseits des Hindernisses 220 liegt; wird ein weiterer 
Befehl ausgelost, nunmehrin negativer Y-Richtung niit vor- 
gegebener Geschwindigkeit bis zurn Y-Wert des Punktes 
214 zu fahren. 

ErfindungsgemaB ist es also nicht mehr notig, die Koordi- 
naten X, Y der gesamten Punkte von 200 bis 214 vorzuge- 
ben. Vielmehr wird jeweils nur ein Y-Achsen-Geschwindig- 
k/pits- und Zielwert vorgegeben, sowie ein Wert auf der Y- 
Achse bei dem eine X-Achsen-Bewegung beginnen soil. 
Der Befehl fiir diese X-Achsen-Bewegung enthalt wie- 
derum. nur Bewegupgsgeschwindigkeit und Zielwert. Ab- 
hangig von der Position auf der X-Achse kann dann wie- 
derum ein neuer Fahrbefehl in Y-Richtung ausgelost wer- 
den, der ebenfalls wieder nur eine Bewegungsgeschwindig- 
keit (diesmal in negative Richtung) auf der Y-Achse und ei- 
nen Zielwert auf der Y-Achse enthalt. 

ErfindungsgemaB ist also die Steuerung und die Program- 
mieruiig erheblich vereinfacht, durch Einstellung der ent- 
sprechenden Brems- und Beschleunigurigsrampenfunktio- 
nefi in den Frequenzumrichtem kann zusatzlich noch dem 
jeweiligen Bewegungswiderstand bzw. der jeweiligen Mas- 
sentragheit des zu bewegenden Maschinenteils Rechnung 
getragen werden. Auf diese Weise fiihrt die Maschine mit ei- 
nem Minimum an Steuerungsaufwand und Progranunierung 
flieBende Bewegungen, auch komplexester Art, aiis. 

Als Steuerungseinheit 40 kann beispielsweise eine spei- 
cherprogrammierfe Steuerung (SPS) .oder ein entsprechen- 
der Mikroprozessor verwendet werden. Ebenfalls ist natiir- 
lich eine Steuerung iiber entsprechende CIM (Computer in- 
tegrated Manuf acturing)-Sy steme moglich . 

Es ist dabei besonders bevorzugt, direkt von der Steue- 
rung 40 aus iiber den Datenbus 30 auch die Beschleuni- 
giings- und Bremsrampenfunktionen der Frequenziimrichter 
verandem zu konnen. Durch diese Rampenfunktionen wer- 
den die Bewegungen der Maschine zu beliebigen Bahnkur- 
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. ven verschlififen. 

Die Frequenzumrichter jeder Achse erhalten von der 
Steuerung 40 jeweils eine;Endpositions- und Geschwindig- . . 
keitsvorgabe, sobald eine Bewegung in dieser Achsenrich-. 
tung ausgefuhrt werden soli. Gleichzeitig erhalt die Steue- 5 
rung dauemd Riickmeldungen tiber die aktuelle Position je- 
der Achse. Anhand der Positionswerte der einzelnen Achsen 
konnen von dem Programm der Steuerung beliebige Aktio- 
nen ausgeiost werden. Auf diese Weise ist die Zahl der Ach- 
sen, die gesteuert werden konnen, thfeoretisch unbegrenzt. 10 
Die Programmieruhg ist auch erheblich erleichtert, insbe- 
sondere wenn drei oder mehrere Achsen fiir die Bewegung 
erforderlich sind, beispiels weise wenn die Waren von der 
Palette nacheinander abgehoben werden sollen, wobei dann 
noch jeweils Bpwegungen in Z-Achse (in Fig. .3 auf den Be- 15 
trachter zu) erforderlich sind. Diese ZTAchsen-Bewegungen 
konnen dann unabhangig von der jeweiligen X- und Y-Ach- 
sen-Bewegung progranuhiert werden. 



43) iiber den Datenbus (30) mit ihren Steueibefehlen 
versorgt werden. 

7. Verfahren nach Anspnich 6, dadurch gekennzeich- 
net, da6 ak Geber (il, 22, 23) Resolver verwendet 
werden. 

Hierzu 2 Seite(n) Zeichnuhgen 



Patentanspriiche 20 

1 . Verfahren zur Steuerung der Bewegungen einer Ma- 
schine mitje einemelektrischen Antriebsmotot (11, 12, 
13) fur jede Bewegungsachse, der jeweils mit einem 
Geber (21, 22, 23) mechanisch gekoppelt ist, und wo- 25 
bei aus den Ausgangssignalen des Gebers (21, 22, 23) 
die Position der Maschine auf der Bewegungsachse be- 
stimmt werden kann, dadurch gekennzeichiiet, daB 
fur jede Bewegungsachse nur ein Startbefehl fiir den 
Antriebsmbtor, eine Bewegungsgeschwindigkeit und 30 
eine Zielposition vorgegeben wird, und Bewegungen 
beliebiger Achsen kombiniert w^den konnen^ indem 

in Abhangigkeit vom Erreichen einer beistimmten Posi- 
tion auf einer Achse der Startbefehl fiir eine weitere 
Achse ausgeiost wird. 35 

2. Verfahren nach Anspruch 1, dadurch gekerinzeich- 
net, daB die Antriebsmotoren (11, 12, 13) jeweils mit- 
tels eihes zugehorigen Frequenzumricbters (41, 42, 43) 
angesteuert werden, der. bestimmte Beschleunigungs- 
und Bremsrampen speichert, denen dann der Bewe- 40 
gungsablauf der Antriebsmotoren (11, 12, 13) folgt. 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
net, daB . eine zehtrale. Steuerung (40) vorgesehen ist, 
die liber einen Datenbus (30) die Ausgangssignale der 
Geber (21, 22, 23) empfangt, und iiber den selben Da- 45 
tenbus (30) die Startbefehle, sowie die vorgegebenen 
Bewegungsgeschwindigkeiten und Endpositioren an 
die Frequenzumrichter (41, 42, 43) . der Motoren (11, 
12, 13) yerteilt. 

4. Verfahren nach Anspruch 3, dadurch gekennzeich- 50 
net, daB der Verlauf def Beschleuhigungs- und Brems- 
rampen von der zentralen Steuerung (40) fiir jede 
Achse und fiir jede Bewegung separat in. den jeweili- 
gen Frequenzumrichter (4i, 42, 43) eingegeben wird. 

5. Verfahren nach einem der Anspriiche .1 bis 4, da- 55 
durch gekennzeichnet, daB fiir jede Achse (100, 110) 
ein Referenzpunkt (102, 112) vorgesehen ist, der au- 
Berhalb der normalen Verfahrstrecken der Maschine 
liegt 

6. Vorrichtung zur Durchfiihrung des Verfahrens nach 60 . 
einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, 
daB.fiir jede Achse ein Antriebsmotor (11, 12, 13) vor- 
gesehen ist, der jeweils mit einem Geber (21, 22, 23) 
mechanisch gekoppelt ist, und dessen Ausgangssignale 
iiber einen Datenbus (30) zur zentralen Steuerung (40) 65 
gefiihrt werden, und jeder Antriebsmotor (11, 12, 13) 
iiber einen Frequenzumrichter (41, 42, 43) mit Energie 
versorgt wird, wobei die Frequenzumrichter (41, 42, 
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